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摘要 和 斜 轴 式 望远镜 是 一 种 新 颖 的 望远镜 结构 , 其 独特 的 结构 设计 更 适合 南极 等 极端 气候 环境 , 但 目前 国内 外 

缺乏 针对 斜 轴 式 望远镜 详细 的 动力 学 建 模 与 控制 研究 . 提出 一 套 斜 轴 式 望远镜 动力 学 建 模 与 鲁 棒 控 制 方法 ， 首 

先 , 对 斜 轴 式 望远镜 进行 了 动力 学 分 析 , 采用 拉 格 朗 日 法 建立 望远镜 2 自由 度 刚体 模型 ; 接着 , 结合 望远镜 驱动 系 

统 的 柔性 和 所 受 干扰 , 完成 了 斜 轴 式 望远镜 的 干扰 情况 下 刚 柔 耦 合 系统 数学 模型 的 推导 ; 然后 , 针对 抗 干扰 问题 ， 


根据 所 建 数学 模型 , 设计 了 


于 干扰 观测 器 和 


控制 ; 最 后 , 仿真 结果 显示 , 在 考虑 模型 的 非 线性 外 音 
干扰 观测 器 的 滑 模 控制 器 使 得 系统 


的 滑 模 控制 
Ke 
有 更 好 的 动态 性 外 


air, 
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1 引言 


文献 标识 码 : A 


不 同 于 传统 的 赤道 式 望远镜 和 地 和 平 式 望远镜 ， 


aA 


该 类 型 望远镜 采用 了 独特 的 斜 轴 
AR, 整个 机 架 可 置 于 封闭 式 夕 


式 望 远 镜 是 一 种 具有 特殊 结构 的 新 型 望远镜 . 


式 机 架 结构 , 外 


INNS 


BAP T, 将 望 


远 镜 内 部 设备 与 外 界 隔 离 , 增强 了 极地 等 恶劣 环境 


下 的 适应 性 . 


目前 仅 有 南极 德 


国 O'Higgins 9 m 射 
望远镜 采用 该 构 型 , 中 国 科 学 院 紫 金山 天 文 台 正 在 
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预 研 的 南极 DomeA 5 m 太 赫 效 望远镜 (5 m Dome 
A Terahertz Explorer，DATE5) 也 准备 采用 该 构 
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对 于 所 受 干 扰 进行 抑制 , 实现 了 斜 轴 式 望远镜 的 鲁 棱 
F 扰 的 情况 下 , 相 比 于 传统 的 比例 -积分 -微分 控制 
g 和 抗 干扰 特性 . 


基于 


ar, 


E, 增加 了 望远镜 指向 系 
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目前 已 有 对 于 和 斜 加 


和 式 望 远 


镜 运 动 学 分 析 的 相关 研究 


2-5] 但 是 


尚 无 详细 完整 


的 动力 学 分 析 研究 ,而 详 


轴 与 方位 轴 的 i 


运动 相对 独立 , 可 以 分 别 对 两 者 进行 


动力 学 分 析 是 控制 器 设 
计 的 基础 . 最 常见 的 地 平 式 望远镜 双 轴 


EX, 高 度 


动力 学 建 模 . 但 斜 轴 


式 望 远 镜 的 构 型 更 加 复杂 , 为 


对 于 多 
拉 格 朗 


了 准确 地 描述 望远镜 的 动力 学 特性 , a BERT OA 
行 综 合 分 析 , 构建 一 个 多 输入 、 多 输出 系统 模型 . 
体系 统 的 力学 分 析 方 法 可 以 分 为 牛顿 法 和 
日 法 ,牛顿 法 建立 在 牛顿 
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三 定律 基础 之 上 ， 
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通过 对 单 体 进行 受 力 分 析 以 获得 动力 学 方程 , 该 方 
法 较为 直观 、 便 于 理解 , 但 是 在 复杂 的 非 自 由 系统 
中 , 对 于 其 约束 力 的 分 析 往 往 变 得 异常 困难 . 拉 格 
朗 日 力学 从 能 量 角 度 出 发 , 利用 虚 功 原理 用 数学 分 
析 的 方法 统一 处 理 任意 非 自 由 质点 的 动力 学 问题 ， 
避免 了 繁琐 的 力学 分 析 , 更 加 适用 于 对 于 复杂 系统 
的 分 析 . 

望远镜 的 指向 精度 依赖 于 控制 算法 的 设计 . 目 
前 ， 传 统 的 望远镜 指向 伺服 控制 器 主要 是 比例 - 
微分 -积分 (Proportion-Integration-Differentiation, 
PID) 控 制 器 问 ，PID 控 制 器 是 工业 上 运用 最 广泛 
的 控制 器 ， 其 结构 简单 、 稳 定性 好 、 参 数 调节 方 
(E. 但 在 高 精度 、 高 非 线性 等 应 用 场景 下 , PID 控 
央 器 难以 满足 要 求 ，Gawronski 研 究 了 线性 二 次 
高 斯 (Linear-Quadratic-Gaussian，LQG) 控 制 器 、 
控制 器 在 大 型 望远镜 指向 控制 上 的 运用 站. 


nw 


LQG 控 制 器 是 基于 优化 理论 的 线性 二 次 高 斯 最 优 
控制 器 , 该 控制 器 对 于 测量 噪声 有 很 好 的 抑制 作用 ， 


能 够 实现 系统 内 部 状态 极点 的 任意 配置, 但 LQG 对 
于 建 模 误差 非常 敏感 .万 ,控制 器 是 一 种 鲁 棒 控制 


模 方法 以 及 鲁 棒 控制 策略 . 首先 , 对 斜 轴 式 望远镜 
进行 动力 学 建 模 . 用 拉 格 朗 日 法 建立 斜 轴 式 望远镜 
刚体 动力 学 模型 ; 再 结合 结构 的 柔性 和 干扰 因素 ， 
建立 了 包含 干扰 项 的 斜 轴 望 远 镜 综 合 模型 ; 其 次 ， 
依据 所 建 模 型 ,设计 基于 干扰 观测 器 的 滑 模 控制 
ax (Disturbance Observer based Sliding Mode Con- 
troller, DOSMC), 将 干扰 观测 器 与 滑 模 控 制 器 相 
结合 , 实现 望远镜 的 鲁 棒 控制 ; 最 后 , 仿真 实验 显 
AR, 相 比 于 传统 的 PID 控 制 器 , 本 文 提出 的 控制 算 
法 使 得 系统 具有 更 好 的 动态 特性 和 抗 干扰 特性 . 


2 动力 学 建 模 与 分 析 
2.1 ”模型 概述 与 坐标 系 的 建立 
斜 轴 式 天 文 望 远 镜 示 意图 如 图 1 所 示 . 图 1 左 图 
显示 了 和 斜 轴 式 望远镜 的 整体 结构 , 该 结构 可 以 分 为 
三 个 部 分 , 分 别 为 基 座 部 分 、 方 位 轴 部 分 和 斜 轴 部 
分 . 基 座 部 分 固定 于 地 面 , 其 不 可 转动 , 在 考虑 自由 
度 时 可 将 其 忽略 ; 方位 轴 部 分 位 于 基 座 之 上 , 其 转 
轴 垂 直 于 地 面 , 可 绕 方 位 轴 360 度 旋转 , 且 具 有 较 好 
的 对 称 性 , 可 将 其 视 为 质心 在 轴线 上 的 刚体 ; RLF 


器 ， 该 控制 器 充分 考虑 了 外 部 干扰 对 于 系统 的 影 
响 ， 通 过 极 小 化 扰动 对 于 模型 输出 的 五 ~ 范 数 ， 实 
现 系统 的 鲁 棒 控制 . 但 五 ,和 鲁 棱 控 制 器 的 鲁 棒 性 往 
往 是 以 控制 器 的 保守 性 换 来 的 , 即 牺牲 闭环 系统 的 
动态 特性 . 基于 干扰 观测 器 (Disturbance Observer, 
DOB) 的 鲁 棒 控制 策略 是 一 种 新 型 的 控制 器 设计 思 
路 由， 该 方法 通过 设计 干扰 观测 器 , 通过 系统 可 测 
变量 来 估计 系统 所 受 干扰 的 大 小 , 这 种 干扰 既 包括 
外 部 扰动 , 也 包括 系统 的 建 模 误差 与 模型 不 确定 性 . 
该 方法 的 最 大 优点 在 于 可 以 将 系统 的 闭环 系统 设 
计 与 抗 干扰 设计 分 离 , 实现 系统 鲁 棒 性 和 闭环 动态 
PERE ARTS HY BOR. 为 了 减少 系统 噪声 的 影响 , 一 般 
避免 用 干扰 观测 器 估计 高 频 扰动 , 对 干扰 观测 器 进 
行 带宽 限制 , 因此 将 存在 部 分 残余 干扰 . 滑 模 控 秆 
器 (Sliding Mode Controller, SMC) 是 一 种 非 线 性 
鲁 棒 控制 器 , 对 于 外 部 干扰 和 不 确定 性 具有 很 强 的 
鲁 棒 性 , 将 滑 模 控制 器 与 干扰 观测 器 相 结合 可 以 进 
一 步 提高 系统 的 鲁 棒 性 四 

本 文 提出 了 一 种 和 斜 轴 式 望远镜 综合 动力 学 建 


— 
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部 分 位 于 方位 轴 之 上 , 其 转轴 与 地 面 呈 45 度 角 ,， 可 
绕 斜 轴 360 度 旋转 , 但 其 质心 偏离 轴线 比较 明显 , 必 
须 考 虑 其 转动 过 程 中 转动 惯量 的 变化 . 
根据 上 述 分 析 , 在 不 考虑 结构 柔性 的 情况 下 ， 
将 斜 轴 望远镜 看 成 由 方位 轴 部 分 和 和 斜 轴 部 分 组 
成 2 自由 度 (Degree of Freedom, DOF) 刚 体系 统 , 如 
图 1 右 图 所 示 . 图 1 右 图 给 出 了 本 文中 的 笛 卡 尔 坐标 
系 建立 方式 , 即 以 方位 轴 转 轴 为 > 轴 且 正方 向 朝 上 ， 
方位 轴 与 地 面 交 点 为 坐标 系 原 点 ， 由 于 方位 轴 的 
对 称 性 ， 可 以 选取 平行 于 地 平面 的 任意 一 个 方向 
为 x 轴 方 向 , 再 根据 右手 定 则 即 可 确定 y 轴 方 癌 . 在 
转动 过 程 中 , 方位 轴 与 斜 轴 的 转动 角度 分 别 定 义 
为 9, 和 0,. 望远镜 的 指向 方向 定义 为 抛物 面 天 线 利 
线 指向 方向 ， 该 方向 与 斜 轴 呈 45 度 角 . 在 方位 轴 角 
度 和 和 斜 轴 角 度 分 别 在 0" 一 360° 范 围 内 变化 时 , AH 
仅 有 一 个 位 置 可 以 使 望远镜 的 指向 方向 与 地 平面 
平行 , 定义 此 时 的 方位 轴 角 度 0. 和 和 斜 轴 角 度 0 为 
自 的 角度 零点 . 图 1 右 图 还 标 出 了 和 斜 轴 式 望远镜 动 
力学 建 模 关键 参数 : 4 x 4 齐 次 矩阵 形式 的 方位 轴 和 
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和 斜 轴 的 转动 惯量 矩阵 , 分 别 表示 为 I AT, RA 


部 


分 质量 表示 为 m; 定义 辅助 点 P 为 斜 轴 部 分 质心 到 


斜 轴 的 投影 点 , 则 P 到 地 平面 的 距离 、 到 z 轴 的 里 


和 到 介 轴 的 距离 分 另 WRAL. lail. 


F 


slant part 


azimuth part 


basement 


图 1 和 斜 轴 式 望远镜 : 结构 示意 图 ( 左 ), 2DOF 系 统 示意 


区 


( 


右 ) 


E 离 


Fig.1 Slant-Axis Telescopes: sketch of structure (left), 


sketch of 2-DOF system (right) 


为 了 表达 的 简便 性 , 本 文采 用 齐 次 4 
统 的 运动 学 与 动力 学 特性 , HRC) 


分 别 表示 以 zx 轴 、y 轴 和 z 轴 为 转轴 的 齐 次 旋转 矩阵 ， 


E 标 描述 系 


R,() 和 R() 


TO, :) 表 示 齐 次 平移 矩阵 , 具体 表达 式 定义 为 : 


1 0 0 
0 cos($) — sin(9) 
R, Q = 
z 0 sin($) cos(9) 
0 0 0 
cos(¢) 0 sin(¢) 
0 1 0 
R,(¢) = 
—sin(d) 0 cos(9) 
0 0 0 
cos($) —sin(?) 1 
R.(6) sin(d) cos(d) 0 
0 0 0 
0 0 0 


Ee O O me 


=. O O e 
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等 : 斜 轴 式 望远镜 动力 学 建 模 与 鲁 棒 控制 6 
1 00 Zz 
0 1 0 y 
T(z, y, z) = ) (4) 
001 z 
0 0 0 1 


其 中 的 % 表 示 旋 转角 度 , 此 时 的 xz、y、z 分 别 表示 在 
三 维 方向 上 的 平移 距离 . 


2.2 ”刚体 动力 学 建 模 

由 于 和 斜 轴 望 远 镜 两 轴 的 非 正 交 性 , 直接 进行 受 
力 分 析 过 程 繁琐 , 本 文采 用 拉 格 朗 日 法 直接 获得 系 
统 动力 学 方程 , 可 避免 见 杂 的 受 力 分 析 . 在 斜 轴 式 
望远镜 工作 时 , 基 座 部 分 并 无 运动 , 方位 轴 部 分 绕 
方位 轴 转 动 , 而 斜 轴 既 有 平 动 又 有 转动 . 因此 , 总 动 
能 包括 方位 轴 部 分 的 转动 动能 、 和 斜 轴 部 分 的 平 动 
动能 和 转动 动能 . 在 齐 次 坐标 系 下 , 方位 轴 角 速度 
为 


=[006&0| ， (5) 


斜 轴 角 速度 为 
T 


ws = wa + R, (Bq) R, (7) - [0 0 6, 0]. (6) 


为 了 描述 系统 的 动力 学 特性 , 还 需要 利用 系统 
的 一 些 几何 参数 和 惯性 参数 . 斜 轴 质 心 的 速度 计算 
相对 复杂 , 首先 , 给 出 质心 的 位 置 表达 式 


p, = R.(6q)T (l2,0,l1)Ry (7) R.(0)lls 0.0 1", 


4 
(7) 
则 其 速度 表达 式 可 以 表示 为 
pe h (8) 


Ot ` 

FH T FED EE KE FT A os R AS, 
此 需要 给 出 绝对 坐标 系 到 相对 坐标 系 的 变换 矩阵 
方位 轴 的 绝对 坐标 系 到 相对 坐标 系 的 变换 矩阵 为 


Ta = R.(a), (9) 
斜 轴 的 绝对 坐标 系 到 相对 坐标 系 的 变换 矩阵 为 
Ts = R.(0,)T (le, 0, ls)Ry (=) R.(63) ’ (10) 
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则 系统 的 总 动能 为 
1 1 

L= zwa Ty La Tawa t zws Ts TTswst am vs. 
(11) 


系统 的 广义 力 包 含 作用 在 方位 轴 上 的 力 和 作 
j 在 斜 轴 上 的 力 , 广义 力 用 Q@ 表 示 , 有 


‘TT 
Q = |Ta, Ts — mgdsin (0,) ; (12) 
EERIE, TAREE, gE 
加 速度 . 定义 望远镜 转轴 角度 向 量 q, = [0a 05)", 可 
得 欧 拉 - 拉 格 朗 日 方程 


OL OL 
其 中 :表示 时 间 , 通过 解 该 矩阵 微分 方程 , 可 得 : 
M, (qi) 4 + Gi(q) =, (14) 


其 中 Mi.(q4) 为 质量 矩阵 ， 其 与 望远镜 结构 块 的 转 


动 惯量 和 质量 以 及 望远镜 的 转轴 角度 有 关 , 质量 矩 
阵 的 具体 表达 式 为 : 
Mı M 
Mig)=| P, (15) 
Mo M22 
IN 中 ， 
1 
Mu = 7 [Bim + Am l2m cos(20s)+ 
4i3, + 2cos?(,)i%, — 2 sin(20,)i3, 十 
4 cos(6s)(W2l3lom — i53) + 2sin(Os)i§o+ 
Asin(9,)i33 + 2133] , (16) 
1 
Miz = Mo = 了 | cos(0:)213l2m = V2i8 3+ 
V2(3m + sin(9.) + 3 +%3)], (17) 
M22 = (Igm + ts) , (18) 


记 、 作 ;分 别 表示 惯 量 和 矩阵 I 和 I 矩阵 第 i 行 第 j 列 的 
i,j 二 1,2,3. Gq) JEJERE, 与 斜 轴 结 构 
块 质量 和 和 斜 轴 角 度 有 关 , 其 具体 表达 式 为 


Gt(qi) = 


0 
V2 l ; (19) 


z Ils sin(@,) 


T = [a | 7 为 输入 力矩 向 量 . 由 于 天 文 望 远 镜 往 
往 工 作 在 超 低 速 范围 内 , 因此 (14) 式 中 忽略 了 角 速 
Eq 的 二 次 项 . 


2.3 “柔性 模型 

望远镜 的 结构 柔性 来 源 主 要 有 两 方面 , 其 一 在 
于 望远镜 的 口径 较 大 时 结构 的 刚度 降低 , 使 得 结构 
整体 的 柔性 不 可 忽略 ; 其 二 在 于 望远镜 传动 系统 的 
柔性 , 主要 是 具 轮 组 或 者 摩擦 轮 传动 时 的 形变 带 3 
的 影响 . 结构 的 柔性 可 以 用 一 阶 弹 得 模型 来 描述 ， 
假设 电机 直接 驱动 一 个 转子 , 转子 经 传动 机 与 望 
远 镜 的 刚体 模型 通过 弹 得 连接 . 分 别 定义 望远镜 
方位 轴 与 斜 轴 的 电机 和 角 位 移 为 qa qi, 转子 惯量 
为 m*、ms,， 传动 系 统 的 刚度 为 ka& s ki 传动 系 
the 
Nra . 为 了 表达 的 简洁 性 , 本 文采 用 等 效 参 数 
来 述 望 远 秆 的 传动 系统 动力 学 方程 ,等 效 参数 与 
其 对 应 的 物理 参数 存在 着 一 定 的 比例 关系 , 比例 关 


系 的 大 小 与 传动 系数 有 关 . 具体 而 言 , 定义 电机 等 
效 输入 力矩 向 量 为 
T 
Tm = [rere 2a] (20) 
电机 转子 等 效 角 位 移 向 量 为 
ab 
da = [rete ri) ， (21) 
定义 电机 转子 的 等 效 惯量 矩阵 
DAON -s 
mn = [r a (22) 
0 rms, 
等 效 刚度 矩阵 为 
天 = es 0 | . (23) 
0 rk 
效 阻尼 和 矩阵 为 
D, = ks 0 | . (24) 
0 rede, 
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则 电机 与 传动 系统 的 动力 学 模型 可 以 用 如 下 方程 
描述 : 


| T= Kn(qn — 4), 

Tm = Mud + Dmq, +T. 
综合 模型 
望远镜 伺服 控制 系统 中 , 不 可 避免 地 存在 各 种 
FH, 这 些 干扰 包括 外 部 风 扰 动 、 非 线性 摩擦 力 、 
未 建 模 动态 和 模型 参数 误差 等 ， 本文 将 这 些 因素 
统一 等 效 为 加 载 在 双 轴 上 的 扰动 力矩 ， FE SA 
的 扰动 力矩 分 别 为 由、 妃 ， 以 及 定义 扰动 向 量 d = 


(25) 


2.4 
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滑 模 控制 器 结合 , 设计 基于 干扰 观测 器 的 请 模 控制 
器 , 作为 斜 轴 式 望 远 镜 的 鲁 棒 控 制 方案 . 第 一 步 , 设 
计 王 扰 观 测 器 , 根据 系统 数学 模型 和 输出 变量 测量 
值 , 设计 观测 器 使 得 可 以 根据 输出 变量 对 干扰 量 进 
行 估计 ; 第 二 步 , 设计 滑 模 控制 器 ， 黄 面 的 设 
计 与 趋 近 率 设计 , 并 据 此 给 出 控制 律 表 达 式 . 

3.1 干扰 观测 器 设计 

基于 干扰 观测 器 的 控制 器 设计 是 一 种 应 对 未 
知 外 部 扰动 和 模型 不 确定 性 的 常见 思路 , 众多 学 者 
对 此 进行 了 广泛 而 详尽 的 研究 四. 文献 [10] 针 对 时 


a 


[ra rT. 将 结构 的 刚体 特性 、 柔 性 和 扰动 进行 综 
合 考虑 , 根据 (14)、(25) 式 , 可 得 


Met dt pal; mm + Du dn, + Gt = Tm F d. (26) 


为 了 便于 控制 器 的 设计 ， 将 上 述 模型 表达 式 
化 为 标准 形式 ， 选 取 状态 变量 z = [zl zs?]7 
la, ål”, 系统 输入 变量 w = r, 输出 变量 y = q, 
a, 根据 (25) 式 , 可 得 如 下 系统 方程 


Tı = T2, 


y = zı, 


其 中 , Fy By HERR ARBOR, BAGEREN 
算 公式 为 F = -Mi (Muni + Dmåm + G+), 
B=M:', H=M: . 


基于 干扰 观测 器 的 滑 模 控制 器 设 
计 

干扰 观测 器 可 以 利用 可 测 变量 , 根据 系统 的 标 
称 模型 来 估计 出 系统 所 受 干 扰 的 大 小 , 能 够 有 效 解 
决 干 扰 变量 测量 困难 的 问题 . 为 了 减少 系统 噪声 的 
影响 , 一 般 避 免 用 干扰 观测 器 估计 高 频 扰 动 , 对 干 
扰 观测 器 进行 带宽 限制 , 因此 将 存在 部 分 残余 干扰 . 
滑 模 控制 器 是 一 种 非 线 性 鲁 棒 控制 器 , 对 于 外 部 干 
扰 和 不 确定 性 具有 很 强 的 鲁 棒 性 . 但 在 外 部 扰动 较 
大 时 , 滑 模 控制 器 输出 切换 频率 较 大 , 实际 控制 器 
难以 实现 无 限 高 的 切换 频率 . 本 文 将 干扰 观测 器 与 


ww 
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变 干扰 变量 内 部 动态 已 知 的 这 一 类 特定 干扰 变量 
进行 了 讨论 , 常见 的 情况 如 假定 外 部 扰动 恒定 或 者 
外 部 扰动 的 频谱 已 知 等 都 可 归 类 为 干扰 变量 内 部 
动态 已 知 . 假设 扰动 变量 d 内 部 动态 可 以 用 如 下 的 
状态 空间 表达 式 描述 : 
i 
d= Cé, 
Eh, W, CH2 x 2 常数 矩阵 , 由 已 知 关于 扰动 的 
E 验 知识 决定 , 为 2 维 辅助 向 量 , 用 于 描述 干扰 的 
j 态 特性 . 根据 文献 10], 设计 如 下 干扰 观测 器 : 


ee Fa, — Bu — Hé), 


d=Cé, 
其 中 , 可 调 参数 A 是 2 维 对 角 和 矩阵 ，@ 为 扰动 向 量 d 的 
估计 值 ，& 为 辅助 变量 上 的 估计 值 . 下 面 证 明 观测 器 
的 收敛 性 . 令 观 测 误 差 向 量 e。= E — ê, 根据 (27)、 
(28)、(29) 式 有 
é,=&-€=W (¢-2) -AHC (€-8) 
=(W-AHC)e, 


(28) 


Hl Ne 


(29) 


(30) 
则 
ės + (AHC —-W)e, =0. (31) 
因此 ， 只 要 合理 配置 参数 A, 即 可 保证 误差 的 
收敛 性 , 并 且 可 通过 调节 (31) 式 的 极点 来 实现 调节 
误差 收敛 的 速度 . 
该 干扰 观测 器 3 
对 一 个 辅助 内 部 变量 进行 观测 ， 再 由 加 


非 直 接 观 测 扰动 本 身 , 而 是 针 
BBY AY ABS 


64 4 
量 间接 给 出 扰动 值 . 通常 情况 下 , 会 合理 设计 W、 
信使 得 该 内 部 动态 系统 成 为 一 个 低 通 滤波 器 ， 减少 
观测 器 输出 中 的 噪声 含量 . 该 滤波 器 的 带宽 的 确定 
有 两 方面 的 考量 : 首先 是 传感器 本 身 的 噪声 情况 ， 
该 观测 器 要 确保 传感器 的 噪声 被 合理 地 抑制 ; 另外 
一 方面 是 考虑 到 扰动 本 身 的 动态 特性 , 对 于 快速 变 
化 的 扰动 , 过 小 的 带宽 会 导致 观测 效果 变 差 , 因此 
干扰 观测 器 的 参数 需要 根据 实际 工程 情况 合理 地 


He 


调节 . 
3.2 ” 滑 模 控制 器 设计 


邻 系统 的 参考 输入 为 y*, 误差 定义 为 e = y* 一 
y = y* — xi, 设计 如 下 滑 模 函数 


s=Ze+e, (32) 
ZARATE BB BS ROERE. 滑 模 控制 器 的 性 


能 与 滑 模 趋 近 律 的 选取 有 很 大 的 联系 . 为 了 减 小 滑 
模 控 制 的 拌 振 效应 , 同时 又 能 保留 较 强 的 动态 特性 ， 
采用 如 下 滑 模 趋 近 律 


3=—Kis— Ks’sgn(s), (33) 
其 中 ， 扩 1!、 芭 2 为 对 角 和 矩阵 且 对 角 元 素 为 正 数 ， 
sgn(:) 表 示 符 号 函数 外. 根据 (27)、(32)、(33) 式 有 
&=Ze€+€ 
ei i 
e+y 2 (34) 
=Ze+y —Fa,- Bu — Hd 
= —K,s — K2s*sgn(s) . 
可 得 控制 律 
u=B'|Ze+y — F(x) —H(a)d 
+Kıs + K2s’sgn(s)| . (35) 
为 了 保证 误差 的 收敛 性 , 需要 进行 稳定 性 证 明 . 考 
虚 如 下 李 雅 普 诺 夫 函 数 
V = sos. (36) 
据 (33) 式 , 有 
V = s" 
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= s |-Kıs — K283°sgn (s)| 
= —K,s° — Ks’sgn (s) 


<0. (37) 


(37) 式 说 明了 系统 的 收敛 性 , 从 理论 上 证 明了 
1 器 的 可 靠 性 . 

以 上 控制 器 设计 过 程 既 利用 了 干扰 观测 器 , 又 
利用 了 滑 模 控制 思想 , 所 得 控制 器 称 为 DOSMC. 基 
于 DOSMC 的 斜 轴 式 望远镜 控制 系统 框图 如 图 2 所 


控 和 


Telescope 


2 ”和 斜 轴 式 望远镜 控制 系统 框图 


Fig.2 The diagram of the control system of Slant-Axis 


Telescopes 
4 数值 仿真 
为 了 验证 本 文 提出 的 斜 轴 式 望远镜 动力 学 建 


模 与 鲁 棒 控制 策略 , 设计 了 仿真 实验 进行 验证 . 仿 
真实 验 在 MATLAB/Simulink 环 境 下 完成 , 表 1 给 出 
了 和 斜 轴 式 望远镜 动力 学 模型 的 仿真 参数 ， 参 数 符 
号 的 定义 与 2.1、2.2 节 保持 一 致 ， 其 中 的 结构 模 
型 的 参数 提取 自 DATE5 望 远 镜 的 有 限 元 模型 ， 驱 
动 系统 模型 参数 参照 了 类 似 尺 寸 的 望远镜 0 为 
了 分 别 验 证 控制 器 的 动态 特性 和 抗 干 扰 特 性 ， 设 
计 了 两 组 实验 ， 每 组 实验 分 别 使 用 传统 的 PID 控 
制 器 (Proportion-Integration-Differentiation Con- 
PIDC) 和 本 文 提出 的 DOSMC 进 行 实验 . 
1 器 的 控制 律 为 9 


troller, 
PID t 


t 
u=Kye+K, | edt+ Kae, (38) 
0 


z 中 ， t 表 示 时 间 ， Ky, K;, Ka 是 2 x 2X7 FA FER, 
为 可 调节 控制 器 参数 . 在 本 文 的 数值 仿真 实验 中 ， 
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控制 器 参数 保持 一 致 , PIDC 的 参数 为 0 0 1 0 20 0 
= ,C= a 
0 0 0 1 0 20 
5 0 3 0 0.5 0 a 
K, = , Ki = ha i 滑 模 控制 器 参数 为 
0 5 0 3 0 0.5 
20 0 5 0 3 
Z = , Ki = , K= 
干扰 变量 参数 矩阵 为 0 20 0 5 0 


表 1 仿真 参数 


Table 1 The parameters of simulation 


Item Value Unit 
ls 0.2906 m 
lo 0.5532 m 
l 4.481 m 
a 4947.8 kg 
1.0 x 104 0 
Mm kg -m 
0 1.0 x 104 
2.5 x 10° 0 
Dy N-s-m-! 
0 2.5 x 10° 
1.0 x 10° 0 
Km N-m7! 
0 1.0 x 108 


5.4486 x 104 —6.4015 x 107? —4.0870 x 10? 0 
—6.4015x 107? 5.3761 x 104 6.9669x10-1 0 
0 


I, kg -m 
—4.0870 x 10? 6.9669 x 107? 1.6495 x 10° 
0 0 0 1 
4.9318 x 10°  —1.8967x 107! —2.1669 x 10? 0 
—1.8967x 107! 1.0388 x 104 3.5221 x 107! 0 
Is kg -m 
—2.1699 x 108 3.5221 x 107! 9.5686 x 10° 0 
0 0 0 1 
4.1 ”正弦 曲线 跟踪 实验 为 0. 方位 轴 与 斜 轴 分 别 在 两 种 控制 器 作用 下 的 角 
民 据 系统 对 于 典型 信号 的 跟踪 能 力 来 判断 系 度 输出 以 及 参考 曲线 如 图 3 所 示 . 从 图 中 可 以 看 出 ， 
统 的 性 能 是 检测 控制 器 设计 优 劣 的 常用 手段 之 一 . PID 控 制 无 法 保证 完美 地 跟踪 正弦 曲线 , 会 有 一 定 
分 别 用 PIDC 和 DOSMC 对 和 斜 轴 式 望远镜 进行 正弦 的 跟踪 滞后 . PID 作 为 线性 控制 器 , 使 用 PID 控 制 器 


轨迹 跟踪 实验 , 参考 系统 的 参考 输入 的 信号 方程 。 的 系统 开 环 传递 函数 在 中 高 频 域 难免 会 有 相位 灌 
为 y* = [10sin (t) 10sin(t)]", 模型 的 初始 状态 全 JE, 在 跟踪 中 高 频 参考 正弦 曲线 时 会 出 现 较 为 明显 
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的 误差 . 虽然 该 现象 可 以 通过 增 大 PID 控 制 器 的 增 


益 系数 来 解决 , 但 上 


于 实际 的 控 人 


调 、 振 动 


or 


or 


所 系统 中 往往 会 存 
在 高 频 测量 噪声 和 外 部 扰动 , 高 增益 可 能 会 导致 超 
t 至 系统 的 不 稳定 . 相 比 之 下 , DOSMC 则 


能 使 得 输出 在 0.5 s 内 完美 地 跟踪 上 正弦 参考 


HA, 


学 R 6 期 


这 得 益 于 滑 模 控制 器 的 高 增益 特性 以 及 滑 模 趋 近 
律 的 设计 , 并 且 由 于 请 模 控 制 器 的 良好 性 质 , 可 以 
实现 高 增益 与 鲁 棒 性 兼 得 . 仿真 实验 证 明 , 相 比 于 


传统 的 PID 控 制 器 ,DOSMC 可 以 获得 更 好 的 动态 
特性 . 


Time/s 


Time/s 


和 3 方位 轴 与 斜 轴 跟 踪 实 验 仿真 结果 曲线 


Fig.3 Curves in the simulation of the tracking experiences for azimuth axis and slant axis 


4.2 ”随机 风 载 实验 


随机 风 载 是 露天 环境 下 大 型 望远镜 指向 控制 
系统 的 主要 外 部 干扰 , 测试 在 随机 风 载 的 作 月 
轴 式 望远镜 双 轴 的 指向 精度 能 够 很 好 地 体现 望 远 
镜 指向 控制 系统 的 鲁 棒 必 


服 系统 的 作 ) 


可 以 


E. 随机 风 


环境 下 的 随机 风速 的 功率 谱 可 以 用 Davenport 


谱 来 表示 : 


Su (w) = 4800vm rk 


ee < Eae 
(1 + B2w?)4/3 ’ 


其 中 , w 表 示 频 率 , wm 表示 该 地 
8 = 人 2, 表示 主 镜 中 心 到 地 二 


K? 


JFR 


载 对 于 望远镜 何 
有 色 噪 声 来 模拟 上 ,1 


自然 
风速 


(39) 


区 的 平均 风速 大 小 ， 


的 距离 , ho 表示 地 
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面 粗 烽 度 , 表示 结构 表面 的 粘性 系数 4: 


1 
由 主人 (40) 
[2.51n (#)] : 
根据 文献 [6], 望远镜 轴 所 受 轴 疝 随机 力矩 大 小 
与 随机 风速 大 小 之 间 呈 正比 : 


AT =kAv, (41) 


内 中 ，AT 表 示 随 机 力矩 大 小 ,Av 表示 随机 风速 大 
小 , kt 为 力矩 系数 : 


1 
kt = 本 capTD um， (42) 
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ap 为 空气 密度 ,ci 为 风向 折算 系数 ，D 为 望远镜 口 。 ”与 真实 什 具 有 总 体 上 一 致 的 走势 , 能 够 很 好 地 体现 
Z, 7 为 圆周 率 . 根据 南极 Dome A 的 气象 情况 和 ”干扰 力矩 的 随机 波动 . 从 图 中 还 可 以 看 出 , 干扰 观 
DATE5 的 结构 设计 ， 取 平均 风速 大 小 wm = 5 m/s, ” 测 器 在 保持 较 高 观测 效果 的 同时 具有 低 通 滤波 效 
空气 密度 op = 0.6 kg/m”, 主 锐 中 心 高 度 h = 5m, H, elie 通过 合理 的 参数 配置 , 该 特性 可 
望远镜 口径 = 5m; ho 取经 验 值 0.1 m, ct 取经 验 以 有 效 地 抑制 测量 噪声 

值 0.25 .生成 轴 上 随机 力矩 的 步 又 如 下 : A AHO BSE FOR 

(1) 根 据 文献 [13] 的 方法 ,生成 功率 谱 为 (39) 式 


差 如 图 5 所 示 . 计算 结果 显示 , 在 PIDC 控 人 


MEH F, 


所 示 的 有 色 噪 声 , 表示 随机 风速 ; 
(2) 根 据 (41) 式 ， 由 随机 风速 生成 标量 随机 力 
JE. 


方位 轴 


与 斜 轴 的 指向 均 方 根 误差 (Root Mean Squ- 


are Error，RMSEB) 分 别 为 0.441” 和 0.378”, 在 DOS- 


仿真 实验 时 。 在 方位 轴 和 斜 轴 上 各 自 施加 由 上 MC 作用 下 ， 方 位 轴 与 斜 轴 的 指向 RMSE 分 别 为 
述 方法 产生 的 随机 力矩 , 测试 望远镜 指向 控制 系统 “0.100 和 0.163， 该 计算 结果 图 中 曲线 的 直观 表 
分 别 在 PIDC 控 制 器 和 DOSMC 控 制 器 作用 下 的 抗 ” 现 相 符 . 显然 DOSMC 对 于 随机 风 载 护 动 具有 更 
干扰 能 力 . 实验 中 , 参考 信号 为 ya = [0 0T, 模型 好 的 抑制 作用 , 相 比 于 传统 算法 , 该 算法 使 得 指向 
的 初始 状态 全 为 0. RMSE 减 少 了 1/2 以 上 . 结合 干扰 观测 器 性 能 分 析 

首先 , 验证 DOSMC 中 干扰 观测 器 的 性 能 . 图 4 ER, 可 以 认为 , 由 于 干扰 观测 器 对 于 外 部 风 载 扰 
展示 了 干扰 观测 器 输出 仿真 结果 曲线 , 图 中 分 别 用 动力 矩 具有 较 好 的 观测 效果 , 再 针对 干扰 的 观测 值 
红色 曲线 和 蓝 色 曲线 展示 了 干扰 观测 器 观测 结果 进行 针对 性 的 处 理 , 使 得 基于 该 观测 器 的 DOSMC 
与 干扰 力矩 的 真实 值 . 从 图 中 可 以 看 出 , 观测 结果 取得 了 较 好 的 干扰 抑制 效果 . 
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4 Curves of the output of disturbance observers in simulation 
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Fig.5 Curves of angle error in the 


结论 

本 文 提出 了 一 套 斜 轴 式 望远镜 动力 学 建 模 与 
鲁 棒 控 制 方法 . 首先 , 运用 拉 格 朗 日 法 建立 斜 轴 式 
望远镜 的 刚体 动力 学 模型 . 接着 , 用 一 阶 模型 近似 
描述 系统 的 柔性 , 并 结合 系统 的 外 部 干扰 和 不 确定 
性 建立 描述 斜 轴 式 望远镜 指向 控制 系统 的 多 输入 、 
多 输出 数学 模型 . 最 后 , 依据 所 建 模 型 分 别 设计 干 


5 


扰 观 测 器 和 滑 模 控制 器 , 实现 了 斜 轴 式 望远镜 的 鲁 
棒 控制 . 仿真 实验 证 明 , 相 比 于 传统 的 不 基于 模型 


的 PID 控 制 算法 , AICHE A Ps 
地 利用 斜 轴 式 望远镜 指向 控 
得 系统 具 


判 算法 可 以 更 充分 
判 系统 的 先 验 知识 , 使 
更 好 的 动态 特性 和 重 棒 性 . 
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Dynamic Modeling and Robust Control for Slant-Axis Telescope 
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(1 Purple Mountain Observatory, Chinese Academy of Sciences, Nanjing 210023) 
(2 School of Astronomy and Space Science, University of Science and Technology of China, Hefei 230026) 


Agsstract The slant-axis telescope has a novel structure and its unique structural design is more 
suitable for extreme environment such as the South Pole. However, there is a lack of research on the 
dynamic modeling and the controller design of slant-axis telescopes at home and abroad. Firstly, the 
dynamical analysis of the slant-axis telescope is carried out. The 2-degree-of-freedom rigid body model of 
the telescope is established by the Lagrange method. Next, combining the flexibility of the driver system 
and disturbance, a mathematical model of the rigid-flexible coupling system of the slant-axis telescope is 
completed. Then, according to the mathematical model, a sliding mode controller based on the disturbance 
observer is designed to suppress the disturbance and realize the robust control of the slant-axis telescope. 
Finally, the simulation results show that the disturbance observer based sliding mode controller gets better 
dynamic performance and anti-disturbance characteristics than the traditional Proportion-Integration- 
Differentiation (PID) controller in the case of considering nonlinear external interference of the model. 


Key words techniques: high angular resolution, pointing control, nonlinear control, miscellaneous 
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